#ifndef _SERVOC_
#define _SERVOC_
#include "HardwareInfo.c"
#include <SetServoTime.h>
#include <SetOneServo.h>

void servoC(unsigned char index, unsigned int angle, unsigned int setTime)
{
    // extern global var
    extern long isX4rcu;

    long isX4 = 0;
    if ( isX4rcu )
    {
        if ( index==1 )
        {
            SetServoTime(_SERVO_1_, angle, setTime);
        }
        else
        {
            if ( index==2 )
            {
                SetServoTime(_SERVO_2_, angle, setTime);
            }
            else
            {
                if ( index==3 )
                {
                    SetServoTime(_SERVO_3_, angle, setTime);
                }
                else
                {
                    if ( index==4 )
                    {
                        SetServoTime(_SERVO_4_, angle, setTime);
                    }
                    else
                    {
                        if ( index==5 )
                        {
                            SetServoTime(_SERVO_5_, angle, setTime);
                        }
                        else
                        {
                            if ( index==6 )
                            {
                                SetServoTime(_SERVO_6_, angle, setTime);
                            }
                            else
                            {
                                if ( index==7 )
                                {
                                    SetServoTime(_SERVO_7_, angle, setTime);
                                }
                                else
                                {
                                    if ( index==8 )
                                    {
                                        SetServoTime(_SERVO_8_, angle, setTime);
                                    }
                                    else
                                    {
                                        if ( index==9 )
                                        {
                                            SetServoTime(_SERVO_9_, angle, setTime);
                                        }
                                        else
                                        {
                                            if ( index==10 )
                                            {
                                                SetServoTime(_SERVO_0_, angle, setTime);
                                            }
                                        }
                                    }
                                }
                            }
                        }
                    }
                }
            }
        }
    }
    else
    {
        SetOneServo(_SERVOCTRL_ST_, index, angle, setTime);
    }
}
#endif

